
METHOD AND DEVICE FOR MEASURING DIRECTIONAL, AND 

COMPUTER PROGRAM 

BACKGROUND OF THE INVENTION 
5 1 ) Field of the Invention 

The present invention relates to a technology for measuring a 
directional (i.e., direction and position) of an object in a three-dimensional 
space. 

10 2) Description of the Related Art 

The directional measuring devices, also called the electronic 
compasses, detect geomagnetic forces in each of a plurality of directions 
using a magnetic sensor corresponding to each direction and calculate a 
direction to be observed, i.e., a directional of an observation axis from the 

15 result of detection. Such directional measuring devices are used in cell 
phones, portable information terminals such as personal digital assistants 
(PDAs), wrist watches, car navigation systems such as vehicle compasses, 
attitude detectors for airplanes, directional measuring devices for visually 
impaired persons, and even game machines. 

20 Particularly, position information service for the portable information 

terminals has been started recently. In the position information service, a 
present position of a portable information terminal is displayed on a screen of 
the portable information terminal along with a map of a surrounding area so 
that the user of the portable information terminal can locate his/her present 

25 position. By thus combining the directional measuring device with the 



> 

portable information terminal on which the position information service can be 
enjoyed, it becomes possible for a user to recognize to which direction he/she 
is facing or to which direction he/she is going. The information providing 
service that employs the position information service and the directional 
5 measuring device is expected to create a lot of new business opportunities in 
various industrial fields in near future, and the other hand, the users are 
privileged by getting useful information. However, the spreading of the 
information providing service requires the precision of the directional 
measuring device to be increased from what it is at present. 

10 The directional measuring devices have a drawback that an azimuth 

cannot be precisely measured if the directional measuring devices are in tilted 
posture. The users of the directional measuring devices may use them or 
hold them in various ways, and it is quite possible that a user holds his/her 
directional measuring device in such a manner that a magnetic sensor in the 

15 directional measuring device is in a tilted posture. If the magnetic sensor is 
in a tilted posture, although the observation axes indicate the identical azimuth, 
an output of the magnetic sensor changes according to an amount of the tilt, 
and therefore, an error may occur in calculation of the azimuths. 

For example, if a biaxial magnetic sensor, which corresponds to an 

20 x-axis and a y-axis orthogonal to the x-axis, is rotated around a vertical axis so 
that the x-axis and the y-axis tilt by a certain tilt angle with respect to the x-y 
plane, the output of the biaxial magnetic sensor cannot be expressed by 
simple sine waveform and cosine waveform but can only be expressed with 
complex waveforms depending on factors such as a dip of the tilt angle. 

25 Consequently, an azimuth 0 (obtained with 9 = arctan (y/x)) calculated from 



the output of the biaxial magnetic sensor is erroneous. 

Japanese Patent Application Laid Open No. 2002-196055 (see page 5, 
equation 2) discloses an omnidirectional magnetic sensor capable of 
automatically correcting a tilt and precisely calculating the direction. Fig. 12 
5 is a flowchart of a process procedure disclosed in the above-mentioned 

literature. As shown in this flowchart, three magnetic vectors corresponding 
to three dimensions (hereinafter, "three-dimensional magnetic vectors") are 
acquired from the output of the magnetic sensor (step SI 201 ). A pitch angle 
and a roll angle of the body of the magnetic sensor are acquired from the 

10 output of a tilt sensor (step S1202). Coordinate transformation is performed 
twice to the coordinates of the three-dimensional magnetic vectors using the 
pitch angle and the roll angle to calculate a magnetic vector of a horizontal 
magnetic field component (step SI 203). An azimuth is calculated from the 
magnetic vector of the horizontal magnetic field component (step SI 204). 

15 More specifically, the omnidirectional magnetic sensor employs a 

method of rotating the geomagnetic vector to the horizontal magnetic field 
component using the rotational transformation. In the rotational 
transformation, a product of a rotation matrix used to rotate the body of the 
omnidirectional magnetic sensor around the X-axis and a rotation matrix used 

20 to rotate the body around the Y-axis in an absolute coordinate system is used. 
The absolute coordinate system includes the X-axis that points towards the 
magnetic north on a horizontal plane, the Y-axis that is orthogonal to the 
X-axis on the horizontal plane, and the Z-axis that is orthogonal to the 
horizontal plane. A observation coordinate system that includes an x-axis 

25 that is the direction towards which the body points, a y-axis that is orthogonal 



to the X-axis, and a z-axis that is orthogonal to the x-axis and the xy plane. 
The rotational transformation is performed with respect to the absolute 
coordinate system. In other words, the rotation matrix corresponding to the 
X-axis is used to rotate the y-axis in the horizontal plane, and the rotation 
5 matrix corresponding to the Y-axis is used to rotate the x-axis in the horizontal 
plane. 

Japanese Patent No. 3008813 (see page 10, Fig. 5) discloses a 
directional measuring device that calculates a true direction by correcting a 
declination of a magnetic direction. Generally, there is a slight difference 

10 between the true north, which is the north on the map, and the magnetic north, 
which is the direction towards which the needle of a magnetic compass points. 
Because of the geographical location of Japan, in Japan, the needle of the 
magnetic compass always points a little westward with respect to the true 
north. The directional measuring device disclosed employs a method to 

15 correct the magnetic direction based on the difference between the direction 
towards which the needle of the magnetic compass points and the true north. 

In the conventional technology, however, when the body is in tilted 
posture, the azimuth of the body can not be obtained precisely, and, the 
ambiguity in the calculation of the azimuth increases as the tilt becomes larger. 

20 Such problem arises because of the fact that, when there is a tilt, the 

rotational transformation of the x-axis and the y-axis does not yield proper 
results. In other words, when there is a tilt, the reverse rotation of the x-axis 
and the y-axis around the X-axis by the roll angle and the reverse rotation of 
the X-axis and the y-axis around the Y-axis by the pitch angle do not yield 

25 proper result. The reason is that the tilt angles (pitch angle and roll angle). 



which are angles between the x-axis or the y-axis and the horizontal plane, 
cannot be used for the rotational transformation as they are. 

When the y-axis is reversely rotated the roll angle around the X-axis to 
make it horizontal, the y-axis is shifted to the horizontal plane, but the x-axis is 

5 also shifted following the shift of the y-axis. Consequently, the tilt angle 
between the x-axis and the horizontal plane does not match the pitch angle, 
that is, a deviation occurs. Therefore, even if the x-axis is reversely rotated 
the pitch angle around the Y-axis, the x-axis cannot be shifted to the horizontal 
plane. The y-axis having already shifted to the horizontal plane also shifts 

10 from the horizontal plane through the rotation around the X-axis to cause the 
y-axis to deviate from the horizontal plane. Thus, in the conventional 
technology, the geomagnetic vectors are not returned to the horizontal plane 
depending on the tilt angles, resulting in erroneous calculation of the azimuth 
including the error accordingly. 

15 On the other hand, it is possible to calculate an azimuth by rotating 

the tilt angle around the x-axis, the y-axis, and the z-axis forming the 
observation coordinate system. However, the x-axis, y-axis, and z-axis are 
difficult to be calculated because the factors involved in the rotational 
transformation become complex, and the azimuth is difficult to be calculated. 

20 

SUMMARY OF THE INVENTION 

It is an object of the present invention to solve at least the problems in 
the conventional technology. 

A directional measuring device according to an aspect of the present 
25 invention measures a direction of a body of the directional measuring device 



5 



in a three-dimensional space including an X-axis indicating magnetic north on 
a horizontal plane, a Y-axis orthogonal to the X-axis on the horizontal plane, 
and a Z-axis orthogonal to the horizontal plane, assuming that the body points 
towards an x-axis. The directional measuring device includes an x-axis 
5 geomagnetic force detector that detects a geomagnetic force along the x-axis; 
an X-axis tilt angle detector that detects an x-axis tilt angle that is an angle 
between the horizontal plane and the x-axis; a determining unit that 
determines the x-axis tilt angle as a rotation angle that is an angle by which 
the X-axis needs to be rotated around the Y-axis so as to be in the horizontal 

10 plane; and an azimuth calculator that calculates an azimuth of the body based 
on the geomagnetic force and the rotation angle. 

A directional measuring device according to another aspect of the 
present invention measures a direction of a body of the directional measuring 
device in a three-dimensional space including an X-axis indicating magnetic 

15 north on a horizontal plane, a Y-axis orthogonal to the X-axis on the horizontal 
plane, and a Z-axis orthogonal to the horizontal plane, assuming that the body 
points towards an x-axis. The directional measuring device includes a y-axis 
geomagnetic force detector that detects a geomagnetic force along a y-axis 
that is orthogonal to the x-axis; a z-axis geomagnetic force detector that 

20 detects a geomagnetic force along a z-axis that is orthogonal to both the 
X-axis and the y-axis; an x-axis tilt angle detector that detects an x-axis tilt 
angle that is an angle between the horizontal plane and the x-axis; a y-axis tilt 
angle detector that detects a y-axis tilt angle that is angle between the 
horizontal plane and the y-axis; a rotation angle calculator that calculates a 

25 rotation angle based on both the x-axis tilt angle and the y-axis tilt angle, 



wherein the rotation angle is an angle by which the y-axis needs to be rotated 
around the X-axis so as to be in the horizontal plane when the x-axis is rotated 
by the x-axis tilt angle around the Y-axis so as to be in the horizontal plane to 
cause the y-axis to rotate following rotation of the x-axis; and an azimuth 
5 calculator that calculates an azimuth of the body based on the geomagnetic 
forces detected by both the y-axis geomagnetic force detector and the z-axis 
geomagnetic force detector and the rotation angle. 

A directional measuring device according to still another aspect of the 
present invention measures a direction of a body of the directional measuring 

10 device in a three-dimensional space including an X-axis indicating magnetic 
north on a horizontal plane, a Y-axis orthogonal to the X-axis on the horizontal 
plane, and a Z-axis orthogonal to the horizontal plane, assuming that the body 
points towards an x-axis. The directional measuring device includes a 
first-axis geomagnetic force detector that detects a geomagnetic force along a 

15 first axis from among the x-axis, a y-axis that is orthogonal to the x-axis, and a 
z-axis that is orthogonal to both the x-axis and the y-axis; a second-axis 
geomagnetic force detector that detects a geomagnetic force along a second 
axis other than the first axis from among the x-axis, the y-axis, and the z-axis; 
a total geomagnetic force input unit that receives a total geomagnetic force at 

20 a present position of the body, wherein the total geomagnetic force is a vector 
addition of geomagnetic forces along the X-axis, the Y-axis, and the Z-axis; a 
geomagnetic force calculator that calculates a geomagnetic force along an 
axis other than the first axis and the second axis, from among the x-axis, the 
y-axis, and the z-axis based on the total geomagnetic force and the 

25 geomagnetic forces along both the first axis and the second axis; an x-axis tilt 



angle detector that detects an x-axis tilt angle that is an angle between the 
horizontal plane and the x-axis; a determining unit that determines the x-axis 
tilt angle as a rotation angle that is an angle by which the x-axis needs to be 
rotated around the Y-axis so as to be in the horizontal plane; and an azimuth 

5 calculator that calculates an azimuth of the body based on the geomagnetic 
force along the x-axis and the rotation angle. 

A directional measuring device according to still another aspect of the 
present invention measures a direction of a body of the directional measuring 
device in a three-dimensional space including an X-axis indicating magnetic 

10 north on a horizontal plane, a Y-axis orthogonal to the X-axis on the horizontal 
plane, and a Z-axis orthogonal to the horizontal plane, assuming that the body 
points towards an x-axis. The directional measuring device includes a 
first-axis geomagnetic force detector that detects a geomagnetic force along a 
first axis from among the x-axis, a y-axis that is orthogonal to the x-axis, and a 

15 z-axis that is orthogonal to both the x-axis and the y-axis; a second-axis 

geomagnetic force detector that detects a geomagnetic force along a second 
axis other than the first axis from among the x-axis, the y-axis, and the z-axis; 
a total geomagnetic force input unit that receives a total geomagnetic force at 
a present position of the body, wherein the total geomagnetic force is a vector 

20 addition of geomagnetic forces along the X-axis, the Y-axis, and the Z-axis; a 
geomagnetic force calculator that calculates a geomagnetic force along an 
axis other than the first axis and the second axis, from among the x-axis, the 
y-axis, and the z-axis based on the total geomagnetic force and the 
geomagnetic forces along both the first axis and the second axis; an x-axis tilt 

25 angle detector that detects an x-axis tilt angle that is an angle between the 



horizontal plane and the x-axis; a y-axis tilt angle detector that detects a y-axis 
tilt angle that is an angle between the horizontal plane and the y-axis; a 
rotation angle calculator that calculates a rotation angle based on both the 
X-axis tilt angle and the y-axis tilt angle, wherein the rotation angle is an angle 
5 by which the y-axis needs to be rotated around the X-axis so as to be in the 
horizontal plane when the x-axis is rotated by the x-axis tilt angle around the 
Y-axis so as to be in the horizontal plane to cause the y-axis to rotate following 
rotation of the x-axis; and an azimuth calculator that calculates an azimuth of 
the body based on the geomagnetic forces along the y-axis and the z-axis and 

10 the rotation angle, 

A directional measuring method according to still another aspect of the 
present invention is a method of measuring a direction of a body of the 
directional measuring device in a three-dimensional space including an X-axis 
indicating magnetic north on a horizontal plane, a Y-axis orthogonal to the 

15 X-axis on the horizontal plane, and a Z-axis orthogonal to the horizontal plane, 
assuming that the body points towards an x-axis. The directional measuring 
method includes detecting a geomagnetic force along the x-axis; detecting an 
X-axis tilt angle that is an angle between the horizontal plane and the x-axis; 
determining the x-axis tilt angle as a rotation angle that is an angle by which 

20 the X-axis needs to be rotated around the Y-axis so as to be in the horizontal 
plane; and calculating an azimuth of the body based on the geomagnetic force 
and the rotation angle. 

A directional measuring method according to still another aspect of the 
present invention is a method of measuring a direction of a body of the 

25 directional measuring device in a three-dimensional space including an X-axis 



indicating magnetic north on a horizontal plane, a Y-axis orthogonal to the 
X-axis on the horizontal plane, and a Z-axis orthogonal to the horizontal plane, 
assuming that the body points towards an x-axis. The directional measuring 
method includes detecting a geomagnetic force along a y-axis that is 
5 orthogonal to the x-axis; detecting a geomagnetic force along a z-axis that is 
orthogonal to both the x-axis and the y-axis; detecting an x-axis tilt angle that 
is an angle between the horizontal plane and the x-axis; detecting a y-axis tilt 
angle that is angle between the horizontal plane and the y-axis; calculating a 
rotation angle based on both the x-axis tilt angle and the y-axis tilt angle, 

10 wherein the rotation angle is an angle by which the y-axis needs to be rotated 
around the X-axis so as to be in the horizontal plane when the x-axis is rotated 
by the x-axis tilt angle around the Y-axis so as to be in the horizontal plane to 
cause the y-axis to rotate following rotation of the x-axis; and calculating an 
azimuth of the body based on the geomagnetic forces detected along both the 

15 y-axis and the z-axis and the rotation angle. 

A directional measuring method according to still another aspect of the 
present invention is a method of measuring a direction of a body of the 
directional measuring device in a three-dimensional space including an X-axis 
indicating magnetic north on a horizontal plane, a Y-axis orthogonal to the 

20 X-axis on the horizontal plane, and a Z-axis orthogonal to the horizontal plane, 
assuming that the body points towards an x-axis. The directional measuring 
method includes detecting a geomagnetic force along a first axis from among 
the X-axis, a y-axis that is orthogonal to the x-axis, and a z-axis that is 
orthogonal to both the x-axis and the y-axis; detecting a geomagnetic force 

25 along a second axis other than the first axis from among the x-axis, the y-axis, 



and the z-axis; receiving a total geomagnetic force at a present position of the 
body, wherein the total geomagnetic force is a vector addition of geomagnetic 
forces along the X-axis, the Y-axis, and the Z-axis; calculating a geomagnetic 
force along an axis other than the first axis and the second axis, from among 

5 the X-axis, the y-axis, and the z-axis based on the total geomagnetic force and 
the geomagnetic forces along both the first axis and the second axis; 
detecting an x-axis tilt angle that is an angle between the horizontal plane and 
the X-axis; determining the x-axis tilt angle as a rotation angle that is an angle 
by which the x-axis needs to be rotated around the Y-axis so as to be in the 

10 horizontal plane; and calculating an azimuth of the body based on the 
geomagnetic force along the x-axis and the rotation angle. 

A directional measuring method according to still another aspect of the 
present invention is a method of measuring a direction of a body of the 
directional measuring device in a three-dimensional space including an X-axis 

15 indicating magnetic north on a horizontal plane, a Y-axis orthogonal to the 

X-axis on the horizontal plane, and a Z-axis orthogonal to the horizontal plane, 
assuming that the body points towards an x-axis. The directional measuring 
method includes detecting a geomagnetic force along a first axis from among 
the X-axis, a y-axis that is orthogonal to the x-axis, and a z-axis that is 

20 orthogonal to both the x-axis and the y-axis; detecting a geomagnetic force 
along a second axis other than the first axis from among the x-axis, the y-axis, 
and the z-axis; receiving a total geomagnetic force at a present position of the 
body, wherein the total geomagnetic force is a vector addition of geomagnetic 
forces along the X-axis, the Y-axis, and the Z-axis; calculating a geomagnetic 

25 force along an axis other than the first axis and the second axis, from among 
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the X-axis, the y-axis, and the z-axis based on the total geomagnetic force and 
the geomagnetic forces along both the first axis and the second axis; 
detecting an x-axis tilt angle that is an angle between the horizontal plane and 
the X-axis; detecting a y-axis tilt angle that is an angle between the horizontal 

5 plane and the y-axis; calculating a rotation angle based on both the x-axis tilt 
angle and the y-axis tilt angle, wherein the rotation angle is an angle by which 
the y-axis needs to be rotated around the X-axis so as to be in the horizontal 
plane when the x-axis is rotated by the x-axis tilt angle around the Y-axis so as 
to be in the horizontal plane to cause the y-axis to rotate following rotation of 

10 the X-axis; and calculating an azimuth of the body based on the geomagnetic 
forces along the y-axis and the z-axis and the rotation angle. 

The computer program according to still other aspect of the present 
invention realizes the methods according to the present invention on a 
computer. 

15 The other objects, features, and advantages of the present invention 

are specifically set forth in or will become apparent from the following detailed 
descriptions of the invention when read in conjunction with the accompanying 
drawings. 

20 BRIEF DESCRIPTION OF THE DRAWINGS 

Fig. 1 is a block diagram of a hardware configuration of a directional 
measuring device according to an embodiment of the present invention; 

Fig. 2 is a diagram of an absolute coordinate system in which the 
directional measuring device is disposed; 
25 Fig. 3 is a block diagram of a functional configuration of the directional 

12 



measuring device; 

Fig, 4 is a diagram to explain a principle for calculation of an X-axis 
rotational angle a of the directional measuring device; 

Fig. 5 is a flowchart of a process procedure for calculating a 
5 directional (hereinafter, "directional calculation procedure") (part 1 ); 

Fig. 6 is a flowchart of a process procedure for calculating a 
directional (hereinafter, "directional calculation procedure") (part 2); 

Fig. 7 is a flowchart of a process procedure for calculating a 
directional (hereinafter, "directional calculation procedure") (part 3); 
10 Fig. 8 is a flowchart of a process procedure for calculating a 

directional (hereinafter, "directional calculation procedure") (part 4); 

Fig. 9 is a flowchart of a process procedure for calculating a 
directional (hereinafter, "directional calculation procedure") (part 5); 

Fig. 10 is a flowchart of a process procedure for calculating a 
15 directional (hereinafter, "directional calculation procedure") (part 6); 

Fig. 11 is a diagram to explain the difference between the directional 
angles when the directional measuring device of the present invention and the 
conventional directional measuring device are used; and 

Fig. 12 is a flowchart of a process procedure of the conventional 
20 technology. 

DETAILED DESCRIPTION 

Exemplary embodiments of a method and a device for measuring a 
directional and a computer program according to the present invention are 
25 explained in detail below with reference to the accompanying drawings. In 

13 



the embodiments, a coordinate system formed with an X (alphabetic capital 
letter) axis that points towards the magnetic north on a horizontal plane, a Y 
(alphabetic capital letter) axis that is orthogonal to the X-axis and is in the 
horizontal plane, and a Z (alphabetic capital letter) axis that is orthogonal to 

5 the horizontal plane, is referred to as an absolute coordinate system. Further, 
a direction towards which the body of the directional measuring device points 
is referred to as an x (alphabetic small letter) axis, an axis that is orthogonal to 
the X-axis is referred to as a y (alphabetic small letter) axis, and an axis that is 
orthogonal to both the x-axis and the y-axis is referred to as a z (alphabetic 

10 small letter) axis. The x-axis corresponds to the X-axis, the y-axis to the 
Y-axis, and the z-axis to the Z-axis. 

Fig. 1 is a block diagram of a hardware configuration of a directional 
measuring device according to an embodiment of the present invention. A 
directional measuring device 100 includes a central processing unit (CPU) 101, 

15 a read only memory (ROM) 102, a random access memory (RAM) 103, a hard 
disk drive (HDD) 104, a hard disk (HD) 105, a display 106, an interi'ace (l/F) 
107, an input key 108, and an analog-to-digital (A/D) converter 109. The 
directional measuring device 100 also includes an x-axis magnetic sensor 110, 
a y-axis magnetic sensor 111 , a z-axis magnetic sensor 112, a global 

20 positioning system (GPS) receiver 113, an analog-to-digital (A/D) converter 
114, an X-axis tilt sensor 115, a y-axis tilt sensor 116, and a z-axis tilt sensor 
117, The components communicate with one another through a bus 118. 

The CPU 101 controls the whole of the directional measuring device 
100. The ROM 102 stores programs such as a boot program. The RAM 

25 1 03 is used as a work area of the CPU 1 01 . The HDD 1 04 controls 
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read/write of data from/to the HD 1 05 under the control of the CPU 1 01 . The 
HD 105 stores data. 

The display 1 06 displays a cursor, icons, or tool boxes, and data such 
as documents, images, and functional information. The display 106 may be 
5 a cathode ray tube (CRT), a thin film transistor (TFT) liquid crystal display, or a 
plasma display. 

The l/F 107 is connected to a network such as the Internet through a 
communication line. The directional measuring device 100 is connected, via 
the l/F 107, to another devices that are connected to the network. The l/F 

10 107 interfaces between the network and the components, and controls 
input/output of data from/to an external device. The l/F 107 may be a 
modem or a local area network (LAN) adaptor. The input unit 108 includes 
keys for inputting characters, numbers, and instructions, and data entry is 
executed through the input unit 1 08. The input unit 1 08 may be a 

15 touch-panel type input pad or a ten-digit keypad. 

The A/D converter 109 converts outputs of the x-axis magnetic sensor 
110, the y-axis magnetic sensor 111 , and the z-axis magnetic sensor 112 to 
digital signals. The x-axis magnetic sensor 110 is disposed on the x-axis and 
detects magnetism of the Earth in the x-axis direction. The magnetism here 

20 means the magnetic flux, the flux density, or the magnetic field. Likewise, the 
y-axis magnetic sensor 111 is disposed on the y-axis and detects magnetism 
in the y-axis direction and the z-axis magnetic sensor 112 is disposed on the 
z-axis and detects magnetism in the z-axis direction. The x-axis magnetic 
sensor 110, the y-axis magnetic sensor 111, and the z-axis magnetic sensor 

25 112 output the detected results in the form of electrical signals to the A/D 



converter 109. 

The GPS receiver 113 receives radio waves from GPS satellites. 
The geographical position of the GPS receiver 113 with respect to each GPS 
satellite is calculated from the data in the radio waves received from a 
5 corresponding one of the GPS satellites. This determination is possible in 
any locations on Earth. The determination is performed using Link 1 (LI) 
radio waves with a carrier wave of 1575.42 megahertz (MHz) and including a 
course acquisition (C/A) code and a navigation message. The C/A code has 
a bit rate of 1 .023 mega-bits-per-second (Mbps) and a code length of 1 023 

10 bits=1 milliseconds (ms). The navigation message has a bit rate of 50 
bits-per-second (bps), sub-frames of a code length 300 bits=6 seconds (s), 
and main frames of code length 1500 bits=30 s. Five sub-frames form one 
main frame and 25 main frames form one master frame. In other words, the 
GPS receiver 113 receives radio waves from the GPS satellites to output GPS 

15 positioning data. 

The A/D converter 114 converts outputs of the x-axis tilt sensor 115, 
the y-axis tilt sensor 116, and the z-axis tilt sensor 117 to digital signals. 
Each of the x-axis tilt sensor 115, the y-axis tilt sensor 116, and the z-axis tilt 
sensor 117 detects a tilt amount of each axis, and includes an acceleration 

20 sensor. Output of biaxial and triaxial acceleration sensor has low sensitivity 
to another axis, and therefore, it is possible to obtain an angle between the 
horizontal plane and each axis. The x-axis tilt sensor 115 is disposed on the 
X-axis and outputs an amount of tilt of the x-axis direction with respect to the 
horizontal plane. The y-axis tilt sensor 116 is disposed on the y-axis and 

25 outputs an amount of tilt of the y-axis direction with respect to the horizontal 



plane. The z-axis tilt sensor 11 7 is disposed on the z-axis and outputs an 
amount of tilt of the z-axis direction with respect to the horizontal plane. 

Fig. 2 is a diagram of an absolute coordinate system in which the 
directional measuring device 100 is disposed. A three-dimensional space 
5 (sphere) 200 formed with the X-axis, the Y-axis, and the Z-axis constitutes the 
absolute coordinate system. The body 120 of the directional measuring 
device 100 is positioned at the origin 0. A direction that is parallel to the long 
side of the body 120 corresponds to the x-axis. An angle between the x-axis, 
when it is projected on a horizontal plane 210, and the X-axis is an azimuth 0. 

10 Further, an angle (x-axis tilt angle) between the horizontal plane 210 and the 
X-axis is referred to as pitch angle pg, and is an angle when the body 120 is 
rotated around the Y-axis to be shifted to the horizontal plane 210. 
Furthermore, an angle (y-axis tilt angle) between the horizontal plane 210 and 
the y-axis is referred to as roll angle ag, and is an angle when the body 120 is 

15 rotated around the X-axis to be shifted to the horizontal plane 210. 

A vector 201 represents a geomagnetic vector in the x-axis direction 
detected by the x-axis magnetic sensor 110, a vector 202 represents a 
geomagnetic vector in the y-axis direction detected by the y-axis magnetic 
sensor 111 , and a vector 203 represents a geomagnetic vector in the z-axis 

20 direction detected by the z-axis magnetic sensor 112. The length of the 
vectors 201 to 203 represents a geomagnetic force in the respective 
directions. 

A vector 204 is obtained by vector addition of the vectors 201 to 203. 
An angle between the vector 204 and the horizontal plane 210 is a dip I at the 
25 present position of the body 120. Therefore, coordinates of the vector 204 in 



the absolute coordinate system can be obtained from: 

(X, Y, Z)=(Sh . cosi, 0, Sh • sini). 
where Sh is an output value indicating the magnitude of the geomagnetic 
vector (total geomagnetic force F). A relation between each of the vectors 
5 201 to 204 and each of the relative geomagnetic forces is described below: 



Isj^VxH^-^-yH'+ZH^ -(1) 

... (2) 



where 

|Sh| : OUTPUT VALUE OF MAGNETIC SENSOR 

CORRESPONDING TO TOTAL GEOMAGNETIC FORCE F 
x;, : VALUE OBTAINED BY NORMALIZING OUTPUT VALUE OF 

X-AXIS MAGNETIC SENSOR BY WHOLE OUTPUT VALUES 
Xh : OUTPUT VALUE OF x - AXIS MAGNETIC SENSOR 
y'„ : VALUE OBTAINED BY NORMALIZING OUTPUT VALUE OF 

y- AXIS MAGNETIC SENSOR BY WHOLE OUTPUT VALUES 
Yh : OUTPUT VALUE OF y- AXIS MAGNETIC SENSOR 

: VALUE OBTAINED BY NORMALIZING OUTPUT VALUE OF 

z- AXIS MAGNETIC SENSOR BY WHOLE OUTPUT VALUES 
Zh : OUTPUT VALUE OF z- AXIS MAGNETIC SENSOR. 



The pitch angle pg (x-axIs tilt angle) and the roll angle ag (y-axis tilt 
15 angle) are detected by the x-axis tilt sensor 115 and the y-axis tilt sensor 116. 
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A relation between the vectors detected by the x-axis tilt sensor 115, the y-axis 
tilt sensor 116, and the z-axis tilt sensor 117 and their relevant tilt amounts is 
described below: 




(5) 



Pg=sin 




(6) 
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2 



... (7) 



where 



Xg : OUTPUT VALUE OF x - AXIS ACCELERATION SENSOR 
Yg : OUTPUT VALUE OF y - AXIS ACCELERATION SENSOR 
Zg : OUTPUT VALUE OF 2 - AXIS ACCELERATION SENSOR 
Wg : TOTAL VALUE OF OUTPUTS OF ACCELERATION SENSORS 
CORRESPONDING TO GRAVITY ACCELERATION. 

Fig. 3 is a block diagram of a functional configuration of the directional 
measuring device 100. The directional measuring device 100 includes a 
geomagnetic force detector 301 , a tilt angle detector 302, a rotation angle 
generator 303, and an azimuth calculator 304. 

The geomagnetic force detector 301 includes an x-axis direction 
geomagnetic force detector 311 (hereinafter, "x-axis geomagnetic force 
detector 311"), a y-axis direction geomagnetic force detector 312 (hereinafter, 
"y-axis geomagnetic force detector 312"), a z-axis direction geomagnetic force 
detector 313 (hereinafter, "z-axis geomagnetic force detector 313"), a total 
geomagnetic force input unit 314, and a geomagnetic force calculator 315. 
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The X-axis geomagnetic force detector 311 detects a geomagnetic 
force in the x-axis direction. More specifically, the x-axis geomagnetic force 
detector 311 detects the geomagnetic force in the x-axis direction from the 
output of the X-axis magnetic sensor 110, and normalizes the geomagnetic 
5 force detected by an output value Sh of the total geomagnetic force F. 

The y-axis geomagnetic force detector 312 detects a geomagnetic 
force in the y-axis direction. More specifically, the y-axis geomagnetic force 
detector 312 detects the geomagnetic force in the y-axis direction from the 
output of the y-axis magnetic sensor 111 , and normalizes the geomagnetic 

10 force detected by an output value Sh of the total geomagnetic force F. 

The z-axis geomagnetic force detector 313 detects a geomagnetic 
force in the z-axis direction. More specifically, the z-axis geomagnetic force 
detector 313 detects the geomagnetic force in the z-axis direction from the 
output of the z-axis magnetic sensor 112, and normalizes the geomagnetic 

15 force detected by an output value Sh of the total geomagnetic force F. 

The total geomagnetic force input unit 314 inputs a total geomagnetic 
force at a present position of the body 120. More specifically, the information 
for the present position of the body 120 obtained from the GPS receiver 113 is 
transmitted to a server (not shown). The server identifies a latitude and a 

20 longitude of the present position of the body 120 from the received present 
position information and transmits the value Sh of the total geomagnetic force 
F corresponding to the latitude and the longitude to the directional measuring 
device 100, The directional measuring device 100 receives the value Sh of 
the total geomagnetic force F. 

25 The geomagnetic force calculator 315 calculates a geomagnetic force 



in a direction of an axis (third axis) other than a first axis and a second axis 
based on the total geomagnetic force at the present position input by the total 
geomagnetic force input unit 314 and geomagnetic force detectors in two axes 
(the first axis and the second axis) of the geomagnetic force detector 301 . 

5 The geomagnetic force detectors in two axes are selected from the x-axis 
geomagnetic force detector 311 , the y-axis geomagnetic force detector 312, 
and the z-axis geomagnetic force detector 313. 

More specifically, if the directional measuring device 100 includes only 
the X-axis magnetic sensor 110 and the y-axis magnetic sensor 111 , a 

10 geomagnetic force in the z-axis direction can be calculated using the equation 
(1). 

The tilt angle detector 302 includes an x-axis tilt angle detector 321 
and a y-axis tilt angle detector 322. The x-axis tilt angle detector 321 detects 
the X-axis tilt angle, which is the pitch angle pg, between the horizontal plane 
15 210 and the x-axis from the output of the x-axis tilt sensor 115. The y-axis tilt 
angle detector 322 detects the y-axis tilt angle, which is the roll angle ag, 
between the horizontal plane 210 and the y-axis from the output of the y-axis 
tilt sensor 116. 

The rotation angle generator 303 includes a rotation angle determiner 
20 331 and a rotation angle calculator 332. The rotation angle determiner 331 
determines the pitch angle pg detected by the x-axis tilt angle detector 321 as 
a rotation angle when the x-axis is rotated around the Y-axis to rotationally 
shift to the horizontal plane 210 (hereinafter, 'Y-axis rotation angle p"). In 
other words, in the calculation principle of an X-axis rotation angle a explained 
25 later, rotational shifting is started from the x-axis as the observation axis, and 



therefore, an error due to rotational shifting of another axis is not included. 
Accordingly, the x-axis tilt angle becomes an identical angle to the Y-axis 
rotation angle p. (See equation (13), explained later) 

If the X-axis is rotated by the x-axis tilt angle (pitch angle pg) around 

5 the Y-axis to be shifted to the horizontal plane 21 0 and the y-axis is rotationally 
shifted following the rotational shifting of the x-axis, the rotation angle 
calculator 332 calculates a rotation angle which the y-axis is rotated around 
the X-axis to be shifted to the horizontal plane 210 (hereinafter, "X-axis 
rotation angle a"). This calculation is performed based on the x-axis tilt angle 

10 detected by the x-axis tilt angle detector 321 and the y-axis tilt angle detected 
by the y-axis tilt angle detector 322. The calculation principle of the X-axis 
rotation angle is explained later 

The azimuth calculator 304 includes a dip input unit 341 , a cosine 
calculator 342, a sine calculator 343, an identifying unit 344, a declination 

15 input unit 345, and an azimuth calculation processor 346. The dip input unit 
341 inputs a dip between the geomagnetic vector at the present position of the 
body 120 and the horizontal plane 210. More specifically, the information for 
the present position of the body 120 obtained from the GPS receiver 113 is 
transmitted to the server (not shown). The server identifies a latitude and a 

20 longitude indicating the present position of the body 120 from the received 
present position information and transmits dip data corresponding to the 
latitude and the longitude to the directional measuring device 100. The 
directional measuring device 100 receives the dip data. 

The cosine calculator 342 calculates a cosine value of an azimuth of 

25 the body 120 based on the geomagnetic force detected by the x-axis 



geomagnetic force detector 311 and the Y-axis rotation angle p determined by 
the rotation angle determiner 331 . The sine calculator 343 calculates a sine 
value sinG of the azimuth 6 of the body 1 20 based on the respective 
geomagnetic forces detected by the y-axis geomagnetic force detector 312 
5 and the z-axis geomagnetic force detector 313 and the X-axis rotation angle 
calculated by the rotation angle calculator 332. The cosine calculator 342 
and the sine calculator 343 are explained in detail later. 

The identifying unit 344 identifies an angular range of the azimuth 
based on the sine value and the cosine value. More specifically, if both the 

10 cosine value cosG and the sine value sinG are positive, the azimuth G is 
identified as an angular range of 0°<G<90°. If the cosine value cosG is 
negative and the sine value sinG is positive, the azimuth G is identified as an 
angular range of 90''<G<180''. Further, if both the cosine value cosG and the 
sine value sinG are negative, the azimuth G is identified as an angular range of 

15 1 80°<G<270''. Furthermore, if the cosine value cosG is positive and the sine 
value sinG is negative, the azimuth G is identified as an angular range of 
270°<G<360°. 

The declination input unit 345 inputs a declination between magnetic 
north at the present position and true north. More specifically, the declination 

20 input unit 345 receives the information for the present position of the body 120 
from the GPS receiver 113 and transmits it to the server (not shown). The 
server identifies latitude and longitude of the present position of the body 120 
from the received present position information and transmits declination data 
corresponding to the latitude and the longitude to the directional measuring 

25 device 100. The directional measuring device 100 receives the declination 



data. 

The azimuth calculation processor 346 calculates an azimuth of the 
body 120. More specifically, if the cosine calculator 342 calculates a cosine 
value cosG of the azimuth 0, then the azimuth calculation processor 346 
5 calculates the azimuth 9 by the inverse function of the cosine value cosG. If 
the sine calculator 343 calculates a sine value sinO of the azimuth 6, then the 
azimuth calculation processor 346 calculates the azimuth 0 by the inverse 
function of the sine value sin0. The azimuth 0 can also be calculated by the 
inverse function of a tangent tanG of the azimuth 0. 
10 Furthermore, when the identifying unit 344 has identified the angular 

range, the azimuth calculation processor 346 can also calculate the azimuth 0 
by the identified angular range and any of the inverse function of the sine 
value sin0, the inverse function of the cosine value cos0, and the inverse 
function of the tangent tan0 of the azimuth 0. Moreover, the calculated 
15 azimuth 0 is corrected by using the declination D input by the declination input 
unit 345 to also calculate an azimuth 0' based on true north as a reference. 

Note that the geomagnetic force detector 301 , the tilt angle detector 
302, the rotation angle generator 303, and the azimuth calculator 304 perform 
their functions when the CPU 101 executes programs stored in the ROM 102, 
20 RAM 103. and HD 105 as shown in Fig. 1. 

Fig. 4 is a diagram of a calculation principle of an X-axis rotational 
angle a of the directional measuring device 100 according to the embodiment 
of the present invention. 

As shown in Fig. 4, unit direction vectors 401 to 403 are provided in 
25 the X-axis, Y-axis, and the Z-axis, respectively. The unit direction vectors 401 



to 403 are rotationally shifted to the x-axis, y-axis, and the z-axis respectively 
using the coordinate expression for their rotations three times (three-rotation 
coordinate expression). 



cose sin9 0 
-sinG cos9 0 
0 0 1 



cosp 0 -sinp 

0 1 0 
sinp 0 cosp 



10 0 ■ 
0 cosQ sina 
0 -sina cosa 



(8) 



Where a is a rotation angle around the X-axis, p is an x-axis tilt angle 
pg as a rotation angle around the Y-axis, and 0 is a rotation angle around the 
Z-axis as an azimuth of the body 1 20. 

10 The three-rotation coordinate expression as shown in equation (8) is 

explained below. As one example, rotation of the X-axis, Y-axis, and Z-axis 
is counterclockwise in the equation (8). In the calculation principle of the 
X-axis rotation angle a, each direction vector of rotated axes (x-axis, y-axis, 
and z-axis of the observation coordinate system) is handled as a unit vector, 

15 and each component of the observation coordinate axes (x-axis, y-axis, and 
z-axis) is basically expressed by using the absolute coordinate system (X-axis, 
Y-axis, and Z-axis). 

The important point of this expression is that the rotation angle around 
the Z-axis and the azimuth 6 of the observation axis (x-axis) can be expressed 

20 as being identical to each other Therefore, a point on a sphere of the 

absolute coordinate system as shown in Fig. 4 is expressed by a product of 
three determinants of rotation matrices as X-axis rotation a, Y-axis rotation p, 
and Z-axis rotation 9. Further, the observation axis (x-axis) corresponds to 



25 



the X-axis to cause "9" in the three-rotation coordinate expression in the 
equation (8) to correspond to the azimuth of the observation axis. 

In other words, it is necessary to rotate an axis (x-axis) to be observed 
initially and rotate the axis around the vertical axis lastly. By using a point on 

5 spatial coordinates rotated in the order, the angle 9 of the rotation angle and 
the azimuth of the observation axis can be identically expressed without 
depending on the X-axis rotation a and the Y-axis rotation p. As explained 
above, the three-rotation coordinate expression is a basic relational 
expression that is derived from the idea and used to derive an azimuth 9 

10 highly precisely. This expression is excellent in that the algorism is simple 
and the program is not complicated. The three-rotation coordinate 
expression is explained in detail below. 

In the three-rotation coordinate expression, the unit direction vectors 
401 to 403 are rotated three times. The unit direction vectors 401 to 403 are 

15 explained below. The unit direction vectors 401 to 403 are rotated an angle a 
around the X-axis (first rotation). The unit direction vector 401 is kept as it is 
even through the first rotation. The unit direction vector 402 becomes a unit 
direction vector 412 through the first rotation. 

The unit direction vectors 401 and 412 after the first rotation are 

20 rotated an angle p around the Y-axis (second rotation). The unit direction 
vector 401 becomes a unit direction vector 421 through the second rotation, 
while the unit direction vector 412 becomes a unit direction vector 422 through 
the second rotation. Then, the unit direction vectors 421 and 422 after the 
second rotation are rotated an angle 9 around the Z-axis (third rotation). The 

25 unit direction vector 421 becomes a unit direction vector 431 through the third 



rotation, while the unit direction vector 422 becomes a unit direction vector 
432 through the third rotation. The unit direction vector 403 becomes a unit 
direction vector 433 through the first to third rotations. The unit direction 
vectors 431 , 432, and 433 after the third rotation are respectively positioned 

5 on the x-axis, y-axis, and the z-axis that form the observation coordinate 
system of the body 120. 

The coordinates of the unit direction vectors 431 to 433 after the third 
rotation can be expressed respectively by the following equations (9) to (11) 
with the angular parameters a, p, and 9 used for the three-rotation coordinate 

10 expression. 
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Further, the pitch angle Pg can be expressed by the following equation 

(12). 



5 



tanP,= . , -(12) 



The relation of the following equation (13) is derived by substituting 
values of the equation (9) in the right side of the equation (12). 

pg=P ... (13) 



Therefore, the pitch angle pg and the rotation angle p around the 
Y-axis as shown in Fig. 4 are identical to each other. 
10 On the other hand, the roll angle ag can be expressed by the following 

equation (14). 



tana,= ...(14). 

vyx +yY 



15 The relation of the following equation (1 5) is derived by substituting 

values of the equation (10) in the right side of the equation (14). 

• -1 *ana 
a = -sin ' ° -.(IS) 

-y/cos^pg x(l + tan^ag) 



Based on the equation (13) and the equation (15), the Y-axis rotation 
20 angle p becomes equal to an angle calculated from the x-axis tilt sensor 115, 
i.e., the pitch angle pg between the x-axis and the horizontal plane 210. 
However, the X-axis rotation angle a does not become equal to the roll angle 
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ag between the y-axis and the horizontal plane 210. (See Fig. 4) Further, a 
negative sign is provided on the right side of the equation (15) because the 
inequality depends on the relation between the roll angle ag and the X-axis 
rotation angle a. The signs of a and ag are reversely provided in this 
5 example, and therefore, the negative sign is provided. As explained above, 
the rotation angle calculator 332 of Fig. 3 can transform the X-axis rotation 
angle a and the Y-axis rotation angle p from the y-axis tilt angle ag and the 
X-axis tilt angle |3g according to the equation (13) and the equation (15) to 
calculate them. 

10 The calculation principle of an azimuth 0 of the directional measuring 

device 100 according to the embodiment of the present invention is explained 
below with reference to Fig. 2 and Fig. 4. A relation between each 
geomagnetic vector obtained from the x-axis magnetic sensor 110, the y-axis 
magnetic sensor 111, and the z-axis magnetic sensor 112 and each direction 

15 of the geomagnetic vectors is viewed. It is assumed that the calculation does 
not undergo magnetic influence except for geomagnetism. As shown in Fig. 
2, if the X-axis is on the XZ plane, an output of the x-axis magnetic sensor 110 
becomes a maximum value Sh. Assume an output of the x-axis magnetic 
sensor 110 is xH and an angle between the geomagnetic vector and the x-axis 

20 is yx. The output xH can be expressed by the following equation (16) in 

which the output xH is proportional to a product of the output value Sh in the 
geomagnetic direction and a cosine cosyx of the angle yx. If yx ranges from 
-90° and 90'', the value of xH becomes positive, and if yx ranges from 90° and 
270°, the value of xH becomes negative. In other words, yx has positive and 

25 negative polarities with respect to the direction of the geomagnetic vector. 



X 



X cosYx = X X Xh = Xh ... (16) 



where 



X : UNIT DIRECTION VECTOR IN x - AXIS DIRECTION 
Xh : OUTPUT VALUE OF x - AXIS MAGNETIC SENSOR. 



It is understood that an inner product, between the unit direction 
vector 421 in the x-axis direction that is rotated by the three-rotation 
coordinate expression and the geomagnetic vector, is derived as shown in the 
equation (16), and that the inner product becomes equal to an output of the 
10 X-axis magnetic sensor 110. Further, it is understood that the y-axis and the 
z-axis have the similar relational equations (equation (17), equation (18)). 

y*S,=y„ ...(17) 
z#S, =Zh ...(18) 

15 where 

y : UNIT DIRECTION VECTOR IN y - AXIS DIRECTION 
z : UNIT DIRECTION VECTOR IN z - AXIS DIRECTION 
yH : OUTPUT VALUE OF y - AXIS MAGNETIC SENSOR 
Zh : OUTPUT VALUE OF z - AXIS MAGNETIC SENSOR. 

Components of the geomagnetic vector 204 are expressed in the 
following equation (20). 

20 



30 





•cosl 




0 




•sini 



(20) 



Where I is a dip as a tilt between the geomagnetic vector 204 and the 
horizontal plane 210, and the upper side of the horizontal plane 210 is a 
positive angle. Therefore, in Japan, the dip faces downward from the 
horizontal plane 210, and accordingly, the dip indicates a negative angle. 

The following equation (21) is obtained by substituting the equation (9) 
and the equation (20) in the left side of the equation (16). 
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= |Sh| X (cosl X cosp X cos6 + sinI x sinp) = Xh ... (21 ) 
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The following equation (22) is obtained by substituting the equation 
(10) and the equation (20) in the left side of the equation (17). 
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JSj-sinl_ 



cosl X (cosa X sin9 -h sina x sinp x cosO) 
-sinlxcospxsina 

... (22) 



The following equation (23) is obtained by substituting the equation 
(11) and the equation (20) in the left side of the equation (18). 
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|Sh| • sini 



cosi X (sina x sine + cosa x sinp x cosS) 
+ sinlxcosaxcosp 



(23) 



The equation (21 ) to equation (23) are combined into one equation 
and the output values of the x-axis magnetic sensor 110, y-axis magnetic 
sensor 111 , and z-axis magnetic sensor 112 are normalized by the total 
geomagnetic force Sh. Therefore, by substituting the equation (2) to the 
equation (4) in the equation (21) to equation (23), respectively, a relational 
expression between the geomagnetism and the azimuth is obtained as shown 
in the following equation (24). 







"cosI x cosp X cos9 + sinI X sinp 




Yh 




cosI X cosa X sinG + cosI x sina x sinp x cose - sinI x cosp x sina 


... (24) 






cosI X sina x sin9 - cosI x cosa x sinp x cos9 + sinix cosa x cosp 





The simultaneous equation of the equation (24) is solved in order to 
obtain a cosine value cosG of the azimuth 0 and a sine value sinG of the 
azimuth 9, and the following equation (25) and equation (26) are obtained. 



sine ^y^x cosa -hz;,x sing ^25) 
cosI 
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cos9= ^"-f' ...(26) 
COSi X cosp 

An actual azimuth 0 is obtained by calculating the inverse function of 
the equation (25) or the equation (26). The dip I is kept as it is if the 
5 measured position remains as it is, and therefore, a value corresponding to 
the measured position may be input as an initial value. 

Fig. 5 is a flowchart of a directional calculation procedure (part 1) 
according to the embodiment of the present invention. The dip I at the 
present position is assumed to be given by the following equation (27) to 
10 equation (29). 

Uoo =5r03'.804 + 73'.745A^-9'.472A>.-0'.771A<2>'-0'.459A<2?AA + 0'.359A?i^ 

... (27) 

Acp = (LATITUDE cp AT MEASUREDPOSITION)-37 ... (28) 

15 AA = (LONGITUDEAATMEASUREDPOSITION)-138 ... (29) 

As shown in Fig. 5, a geomagnetic force in the x-axis direction is 
detected from the output of the x-axis magnetic sensor 110 (step S501 ). An 
X-axis tilt angle (pitch angle pg) is detected from the output of the x-axis tilt 
20 sensor 115 (step S502). The x-axis tilt angle (pitch angle pg) is determined, 
using the equation (13), as a Y-axis rotation angle p as a rotation angle when 
the X-axis is rotated around the Y-axis to be shifted to the horizontal plane 210 
(step S503). A cosine value cos6 of the azimuth 9 is calculated, using the 
equation (26), based on the geomagnetic force in the x-axis direction and the 



determined Y-axis rotation angle p (step S504). The azimuth 9 is calculated 
from the inverse function of the cosine value cos0 (step S505). According to 
the process procedure, only by detecting the geomagnetic force in the x-axis 
direction and the x-axis tilt angle pg, it is possible to calculate the azimuth 0 of 
5 the body 120 using the simple computational equation. 

Fig. 6 is a flowchart of a directional calculation procedure (part 2) 
according to the embodiment of the present invention. The dip I at the 
present position is assumed to be given by the equation (27) to the equation 
(29). 

10 As shown in Fig. 6, geomagnetic forces in the y-axis direction and the 

z-axis direction are detected from the outputs of the y-axis magnetic sensor 
111 and the z-axis magnetic sensor 112 (step S601). An x-axis tilt angle 
(pitch angle Pg) and a y-axis tilt angle (roll angle ag) are detected from the 
outputs of the X-axis tilt sensor 115 and the y-axis tilt sensor 116 (istep S602). 

15 The X-axis rotation angle a is calculated, using the equation (25), based on 
the pitch angle pg and the roll angle ag (step S603). A sine value sinO of an 
azimuth 9 is calculated based on the geomagnetic forces in the y-axis 
direction and the z-axis direction and the X-axis rotation angle a (step S604). 
The azimuth 9 is calculated from the inverse function of the sine value sin9 

20 (step S605). According to the process procedure, only by detecting the 
geomagnetic forces in the y-axis direction and the z-axis direction and the 
y-axis tilt angle (roll angle ag), it is possible to calculate the azimuth 9 of the 
body 120 using the simple computational equation. 

Fig. 7 is a flowchart of a directional calculation procedure (part 3) 

25 according to the embodiment of the present invention. As shown in Fig. 7, at 



first, a dip I at the present position is input from an external server (step S701 ). 
Then, a sine value sin9 and a cosine value cosG of an azimuth 9 are 
calculated (step S702). 

The calculation of the sine value sin9 and the cosine value cos9 is the 

5 same as that of the flowcharts in Fig. 5 and Fig. 6, and therefore, explanation 
thereof is omitted. An angular range of the azimuth 9 is identified from the 
calculated sine value sinG and cosine value cos9 (step S703). The azimuth 9 
is calculated from the angular range and the inverse function of the calculated 
sine value sin9 or cosine value cos9 (step S704). According to the process 

10 procedure, the dip I at the present position is acquired each time the azimuth 9 
at the present position is measured to allow precise measurement of direction. 

Fig. 8 is a flowchart of a directional calculation procedure (part 4) 
according to the embodiment of the present invention. The dip I at the 
present position is assumed to be given. As shown in Fig. 8, at first, 

15 geomagnetic forces in the x-axis direction, y-axis direction, and the z-axis 

direction are detected from the outputs of the x-axis magnetic sensor 110, the 
y-axis magnetic sensor 111, and the z-axis magnetic sensor 112 (step S801). 

Next, an x-axis tilt angle (pitch angle pg) and a y-axis tilt angle (roll 
angle ag) are detected from the outputs of the x-axis tilt sensor 115 and the 

20 y-axis tilt sensor 116 (step S802). The X-axis rotation angle a is calculated, 
using the equation (15), based on the x-axis tilt angle (pitch angle pg) and the 
y-axis tilt angle (roll angle ag) (step S803). The x-axis tilt angle (pitch angle 
(3g) is determined, using the equation (13), as the Y-axis rotation angle p that 
is a rotation angle when the x-axis is rotated around the Y-axis to be shifted to 

25 the horizontal plane 210 (step S804). A tangent value tan9 of the azimuth 9 



is calculated based on the geomagnetic forces in the x-axis direction, y-axis 
direction, and the z-axis direction, the X-axis rotation angle a, and the Y-axis 
rotation angle p (step S805). The azimuth 9 is calculated from the inverse 
function of the tangent value tanG (step S806). 

The tangent value tan9 of the azimuth 9 is explained below. The 
following equation (30) is an equation of the tangent value tan9 of the azimuth 
9 obtained from the equation (25) and equation (26). 



tane = (yHxcosq + z;,xsina)xcosp ^^^^ 
x^-sinlxsinp 



According to the process procedure, only by detecting the 
geomagnetic forces in the x-axis direction, y-axis direction, and the z-axis 
direction, the x-axis tilt angle pg, and the y-axis tilt angle ag, it is possible to 
calculate the azimuth 9 of the body 120 using a simple computational 
equation. 

The tangent value tan9 of the azimuth 9 can be expressed by the 
equation without using the dip by using the method as follows. More 
specifically, the sine value sin! of the dip I in the output components of the 
X-axis magnetic sensor 110 expressed by the equation (24) is solved to obtain 
the following equation (31). 



. . x'— cosBxcosGxcosI 

sinl = — = ..(31) 

sinp 
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By using the equation (31 ), the cosine value cosi of the dip I in the 
output components of the y-axis magnetic sensor 111 expressed by the 
equation (24) is solved to obtain the following equation (32). Furthermore, 
the cosine value cos! of the dip I in the output components of the z-axis 
magnetic sensor 112 expressed by the equation (24) is solved to obtain the 
following equation (33). 



cool ^ ^'"^ ^^^^ (32) 

cosa X sinp x sin9 + sina x cosG 

Zh xsinB-x' xcosaxcosp 

cosI = — ^ — ^ ^ . . . (33) 

sina X sinp x sine - cosa x cose 



The equation (31) to the equation (33) are combined and developed to 
obtain the following equation (34). The azimuth is calculated by the following 
equation (35) that expresses the inverse function of the equation (34). 



sine y^ X cosa + Zh X sina ^2^^ 

cose y^ X sina X sinp - ZhCOSo x sinp - x^ x cosp 



10 



e = arctan 



^ y^ X cosa + ZhX sina ^ 

y H X sina x si np - z^cosa x sinp - x^ x cosp 



(35) 



The dip varies by the present position and the change with aging of 
the body 120. Furthermore, the dip can be input from an external server 
20 through the dip input unit 341 . However, if the dip data in the server is not 
updated so often, the dip I is not included in the computational equation of the 
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equation (34) or the equation (35), and therefore, dip-independent azimuth 
measurement can be realized with high precision. 

Fig. 9 is a flowchart of a directional calculation procedure (part 5) 
according to the embodiment of the present invention. At first, a declination 
5 D at the present position is input (step S901). For the declination at the 
present position in Japan, the results of measurement of magnetism are 
disclosed as a table by the Geographical Survey Institute, and therefore, the 
declination D at any region is obtained by the table. The declination D is also 
obtained by using a declination calculating method of approximating it by a 
10 quadratic equation. More specifically, the declination D can be calculated 
using the following equation (36) to equation (38). 



D2000.0 = 7^37. 1 42' + 2 1 .622'A(p - 7.672'AA + 0.442' Acp^ - 0.32'A(pAA + 0.675'AA^ 

... (36) 

15 A(p = (LATITUDE (p AT MEASUREDPOSITION)-37 ... (37) 

AA = (L0NGITUDEAATMEASUREDP0SITI0N)-138 ... (38) 



Next, an azimuth 0 based on magnetic north as a reference is 
calculated (step S902). The calculation procedure of the azimuth 9 is the 

20 same as that of the flowcharts of Fig. 5 to Fig. 8, and therefore, explanation 
thereof is omitted. The azimuth 9 is corrected by the declination D input to 
calculate an azimuth 9' based on true north as a reference (step S903). By 
performing the calculation procedure, the azimuth 9' can be calculated, which 
allows further higher-precision direction measurement to be performed. 

25 Fig. 10 is a flowchart of a directional calculation procedure (part 6) 
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according to the embodiment of the present invention. This directional 
calculation procedure includes measuring an azimuth 9 by a so-called biaxial 
magnetic sensor. As one example, the y-axis is determined as a first axis, 
the z-axis as a second axis, and the x-axis as a third axis. The magnetic 
sensor is provided on the first axis and the second axis, but not provided on 
the third axis. 

As shown in Fig. 10, at first, geomagnetic forces in the directions of 
the first axis and the second axis are detected from outputs of the first axis 
and second axis magnetic sensors (step S1 001 ). A total geomagnetic force 
at the present position is input (step SI 002). The total geomagnetic force F 
in each region in Japan can be approximated by the following equation (39) to 
equation (41). 



F2000.0 = 47505.3881 + 567.453A(p - 294.499AA - 0.225A(p' 

... (39) 

-2.975A(pAA + 1.291AA'= 

Acp = (LATITUDE CP AT MEASURED POSITION) -37 ... (40) 

AA = (LONGITUDEAAT MEASURED POSITION)- 138 ... (41) 



Next, a geomagnetic force In the direction of the third axis is 
calculated (step SI 003). The geomagnetic force in the third axis direction 
can be calculated at this step by the following equation (42) to equation (44). 



x'=T^ ...(42) 

" S'k ^ ^ 
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where 



(44) 



Xh . Yh : VALUES OBTAINED BY NORMALIZING OUTPUT 

VALUES OF X - AXIS AND y - AXIS MAGNETIC SENSORS BY S' h 
x„ , Ph : OUTPUT VALUES OF x - AXIS AND y - AXIS MAGNETIC SENSORS 

|S' I : OUTPUT VALUE OF MAGNETIC SENSOR CORRESPONDING 

I h I 

TO TOTAL GEOMAGNETIC FORCE F. 

The calculated geomagnetic force of the third axis is output (step 
S1004). The steps thereafter are the same as those in Fig. 5 to Fig. 9, and 
therefore, explanation thereof is omitted. According to this procedure, the 
biaxial magnetic sensor is capable of measuring directions with high precision 
in the same manner as that of the triaxial magnetic sensor. Furthermore, it is 
possible to reduce the number of components, minimize, and reduce its 
weight, thus providing the directional measuring device 100 at a low cost. 

A comparative example between the directional measuring device 100 
and a conventional directional measuring device is explained below. The 
following table 1 compares azimuths of the directional measuring device 100 
with those of the conventional directional measuring device with respect to set 
angles. The comparison is made based on the conditions of a roll angle ag = 
20° and a pitch angle pg = 20°. The following values are also given in the 
table 1 . That is, the values include norrrialized geomagnetic output values in 
the respective axes of the directional measuring device 100 and tangent 
values of the azimuths 9 calculated from the rotation angles. 
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In the table 1 . the normalized outputs of from the x-axis magnetic 
sensor to the z-axis magnetic sensor include normalized values and directions 
of geomagnetic vectors in the respective axes. Positive and negative output 
values represent directions of the geomagnetic vectors of the respective axes. 

5 It is understood from the results of the table 1 that slightly smaller 

values are shown with respect to the set angles in the conventional 
technology and that a numerical deviation ranging from about -9° to about -7° 
occurs. The deviation angle has a tendency to increase as an increase in the 
roll angle ag and the pitch angle pg. On the contrary, the azimuth 9 

10 calculated in the present invention is substantially identical to the relevant set 
azimuth 9, and it is therefore understood that no deviation angle occurs 
substantially. 

Furthermore, detailed comparison is made between the embodiment 
of the present invention and the conventional technology. Fig. 11 is a 

15 diagram of comparison between deviations of the directional angles when the 
directional measuring device 1 00 of the present invention and the 
conventional directional measuring device are used. Since the directional 
measuring device 100 is thought to be used or to be held by the users in 
various ways, azimuths calculated in each case where the tilt angle is 

20 changed to various values were compared with each other. The x-axis in the 
figure represents a set azimuth, and the y-axis represents a deviation of 
respective calculated azimuths by the directional measuring device 100 of the 
present invention and the conventional directional measuring device from a 
set azimuth. As shown in Fig. 11, void triangle, rectangle, circle, and 

25 rhomboid represent deviation angles from the set angles when the roll angle 



ag and the pitch angle Pg are changed in the conventional technology, and 
black circles represent a deviation angle from the set angle in the present 
invention. 

As is clear from Fig. 11, positive deviation and negative deviation 
5 occur depending on the tilt angle in the conventional technology. 

Furthermore, if the tilt angle becomes larger, the deviation angle becomes 
larger. The deviation angle becomes larger, for example, in the case of the 
void rectangles (ag = 40"*, pg = 20°) as compared to the void triangles (ag = 
20°, Pg = 20°). On the other hand, in the embodiment of the present 

10 invention, the results measured under the condition of ag = 40° and pg = 20° 
are shown in Fig. 11 in which the deviation angle from the set angle is almost 
zero. It is therefore understood from the results that calculation is performed 
with high precision even if the tilt angle becomes larger. 

In the explanation with reference to the embodiment, normalization is 

15 performed by an output value Sh of the magnetic sensors 110 to 112 

corresponding to a total geomagnetic force F. The total geomagnetic force F 
can also be calculated by detecting the horizontal component of 
geomagnetism and the dip 1. According to this, the maximum value of the 
output when the directional measuring device 100 is rotated once along the 

20 horizontal plane 210 corresponds to the horizontal component of the 

geomagnetism. Therefore, output values Sh of the magnetic sensors 110 to 
112 corresponding to the total geomagnetic force F can also be calculated 
from the output. 

In the embodiment, the acceleration sensor is used as the tilt sensors 
25 115 to 117, but the sensor is not limited to the acceleration sensor if any tilt 



sensor can measure an angle between the horizontal plane 210 and the 
respective axes. 

In the embodiment, the measuring method used in Japan has been 
explained, but it is not limited to the measuring method. If a latitude and a 

5 longitude of a measured position are given in any region all over the world, it 
is possible to obtain the declination, total geomagnetic force, or the dip. The 
information for the declination D, total geomagnetic force F, and the dip I are 
prepared in advance as database by acquiring the latitude and the longitude, 
which allows acquisition of the declination, total geomagnetic force, and the 

10 dip at any region all over the world. 

Furthermore, the calculation equation is not limited to that in the 
above embodiment, and therefore, the users can use any of methods as 
follows to acquire the calculation equation. The methods include a method of 
directly inputting the declination D by the user to perform calculation, and a 

15 method of automatically acquiring position information through 

communications, radio waves, or GPS to calculate it with a measurement 
equation. The methods also include a method of automatically acquiring it 
through access to a server, on a network, including a table in which position 
information correlates with declination, total geomagnetic force, and dip. 

20 Furthermore, in the embodiment, the explanation is given based on an 

integrated circuit (IC) module, but it is not limited to this. Therefore, the 
directional measuring device 100 including a display unit and a power source 
and operating as a single unit may be used. Alternatively, the directional 
measuring device 100 may be incorporated in any of electronic devices. 

25 Further, all the hardware components as shown in Fig. 1 are not necessarily 



integrated into one unit, but, for example, the measurement may be performed 
by a CPU or a microcomputer in the device including the directional 
measuring device 1 00. 

In the embodiment, data for the declination D, the total geomagnetic 
5 force F, and the dip I can be acquired from the latitude and the longitude of the 
present position. Therefore, the user can freely select or combine the data. 
Even if the user does not select the data, initial values of the data can be 
stored in the directional measuring device 100 to measure a direction using 
them. 

10 Furthermore, in the embodiment, a total output value Wg has been 

calculated with a square root of a squared sum of the output values of the 
acceleration sensors in the respective axes by using the triaxial acceleration 
sensor as the tilt sensors 115 to 117 in the three axes. However, since the 
gravity acceleration g corresponds to the total output value Wg, the total 

15 output value may be used. In this case, by calculating the total output value 
Wg, an acceleration in the measurement is obtained. Furthermore, by 
comparing the acceleration with the known gravity acceleration, information as 
to whether any acceleration factor other than the gravity acts is also obtained, 
and therefore, correction may be performed using the information. Moreover, 

20 the tilt sensors 115 to 117 may be configured not with three axes but with two 
axes. In this case, by inputting the total output value Wg corresponding to 
the gravity acceleration, a tilt angle of the respective axes can be calculated. 

It is assumed that the directional measuring device 1 00 is used and 
held by the users in various ways, and it is quite possible that the directional 

25 measuring device 100, i.e., the magnetic sensors 110 to 112 may be used 
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even when they are tilted with respect to the horizontal plane 210. In such a 
case also, it is possible to calculate the azimuth 9 with high precision even in a 
state where the body 120 is tilted. Particulariy, the present invention is 
effective in cell phones, portable information terminals such as PDA, and wrist 

5 watches. Furthermore, the algorism used in the directional measuring device 
100 is simple to make it easy to be incorporated in various devices. 

As explained above, according to the directional measuring device 
and method and the direction measuring program, by using the simple 
computational equation based on the coordinate system for rotations three 

10 times such that rotation is performed in the order of the X-axis, the Y-axis, and 
the Z-axis, it is possible to simply measure a direction with high precision. 

The direction measuring method according to the embodiment of the 
present invention is realized by executing the previously prepared program on 
a computer such as a personal computer and a work station. The program is 

15 recorded in a computer-readable recording medium such as a hard disk, a 
flexible disk, a compact disk-read only memory (CD-ROM), a magneto-optic 
disk (MO), and a digital versatile disk (DVD). The program is then executed 
by being read out from the recording medium by the computer. Furthermore, 
the program may be a transmission medium capable of being distributed 

20 through a network such as the Internet. 

Although the invention has been described with respect to a specific 
embodiment for a complete and clear disclosure, the appended claims are not 
to be thus limited but are to be construed as embodying all modifications and 
alternative constructions that may occur to one skilled in the art which fairiy fall 

25 within the basic teaching herein set forth. 



